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ABSTRACT 


Proportional Navigation and Command To Line Of Sight 
missile minidanes are explored. A system flow graph is 
developed for each guidance technique. The block transfer 
functions are developed and a state space representation of 
the systems is defined. The missile systems are then tested 
using one two-dimensional engagement and two three-dimensional 
engagement scenarios. The final three-dimensional scenario 
introduces measurement noise in order to evaluate the effect 
of noise on the guidance algorithms. The engagement results 
are then compared to analyze the miss distance of each type of 


missile guidance. 
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I. INTRODUCTION 


A guided missile can be controlled using two different 
methods. The first is when the missile contains its own 
guidance system. This type of missile is beneficial in that 
once fired it will track its target. The second type of 
guidance has a ground fire control system to command the 
missile. This type of missile, called command guided, does 
not contain a target seeker. Two radars, or one radar capable 
of tracking two targets, are required at the fire control 
station; one will track the missile and the other the target. 
The fire control system will calculate the required missile 
acceleration commands and relay them to the missile by either 
a radio link or fiber optic cable. 

The type of guidance system implemented is largely 
dependent on the missile's mission. A long range missile will 
need a self contained guidance system. A point defense 
missile will use a self contained seeker or command guidance. 

The guidance system supplies the input to the missile 
control system. We will use a roll stabilized “skid-to-turn" 
missile. The roll stabilization will permit a simpler 
analysis because there is no coupling between pitch and yaw. 


Figure 1 shows a block diagram for a missile control system. 


Missile Body Seeker 


| seeker 
autopilot 


tracking 


Ground Based Radar 





Figure 1. General Missile Guidance System 


Missile interception simulations using command to line 
of sight and proportional navigation guidance systems are 
developed. Chapter II explains the guidance laws. Chapter 
III develops the simulation algorithms. Chapter IV tests the 
algorithms with known two-dimensional results and a three- 
dimensional problem with and without measurement noise. 


Chapter V discusses the simulation, conclusions, and 


recommendations. 


II. MISSILE GUIDANCE LAWS 
A. GENERAL 


The missile guidance system provides the autopilot with 
the necessary information to produce the required acceleration 
commands. The missile/target intercept geometry has several 
important parameters. Figure 2 depicts a typical 


missile/target intercept scenario. 





Figure 2. Missile And Target Intercept Scenario 


several important parameters can be developed by 
analyzing Figure 2. 

R, : Tracker to missile range 

R, : Tracker to target range 

O, : Tracker to missile line-of-sight angle 

O, : Tracker to target line-of-sight angle 

Ym : Missile velocity vector angle 

Y, : Target velocity vector angle 
The two guidance techniques to be discussed are proportional 


navigation and command-to-line-of-sight. 
B. PROPORTIONAL NAVIGATION 


Proportional navigation missiles are guided by either 
reflected or emmitted energy from the target. A passive 
missile will be guided from the IR, EO, or RF emmitted by the 
target. An active missile will send an RF signal out to track 
the target. In each case the energy is received by a seeker 
which tracks the target. 

Proportional navigation is based on the rate of change of 
the missile to target line-of-sight (LOS). The missile 
commanded acceleration is proportional to the rate of change 
of the LOS. The ratio of the missile turning rate to the LOS 
rate of change is called the proportional navigation constant 


(N). 


V (2.1) 


The proportional navigation constant must be greater than 2 to 
ensure system stability. A proper value of N will ensure that 


the missile to target angle o,, will remain constant thus 


ensuring missile intercept. Figure 3 illustates this point. 


TARGET FLIGHT 


MISSILE FLIGHT 


Figure 3. Missile Collision Course Theory 





Assuming an acceleration is applied at right angles to 


the velocity vector of the missile for a period of 
the missile's velocity will then be V,(ttdt). The 
vector will have changed direction by dy,,. 


Assuming a small angle approximation yields 
a dt = V dy. 


a m . Ne 


Combining (2.1) and (2.2) leads to 


a_= V_NO 


This result is the proportional navigation law that 


time dt, 


velocity 


(2.2) 


(2.3) 


will be 


implemented in this simulation. 


C. COMMAND GUIDANCE 


The Command To Line Of Sight (CLOS) missile is given 


guidance commands that keep the missile in the LOS between 


the launch point and the target. The distance between the 


missile and the LOS is defined as the cross range error 
(CRE). The fire control system will supply the proper 
commanded acceleration to drive the CRE to zero. 

Since two separate radars are required for this type of 


guidance the problem geometry is slightly different than 


previously described. Figure 4 shows the CLOS system 


geometry. 


MISSIL 





Figure 4. Command To Line Of Sight Geometry 


III. SYSTEM DEVELOPMENT 


A. OVERVIEW 


The system block diagram is shown in Figure 1. The block 
transfer functions, system dynamics, and simulation equations 


will be developed for the simulation. 
B. RADAR DEVELOPMENT 


~~ Target flight is tracked using angles in the pitch and 
yaw planes. The pitch plane is defined as the vertical plane 
that contains the target and the radar. The yaw plane is 
defined as the xy plane. 
1. Proportional Navigation 


Proportional navigation system geometry is shown in 


Figure 5. 





Figure 5. Proportional Navigation System Geometry 


From Figure 5 the following angles can be defined: 


Gncay 3 Missile yaw angle 
Orseep. 3 Missile pitch angle 
Cnvay: 3 Target yaw angle 

Op seen 3 Target pitch angle 


The system requires that the following ranges be defined: 
R, : Radar to missile range 
R, : Radar to target range 
R : Missile to target range 
By applying elementary trigonometry to the cartesian 
system geometry defined in Figure 5, the following equations 


can be derived 


be 

Oo = arctan | — 

May Xx 

m 

Zn 

Oo | = arctan 

™pitch x? sy? 
m am 


(3.1) 





The radar system will produce the following angles 
Cus, Missile to target yaw plane angle 
Oe. 1 Missile to target pitch plane angle 


The angles are given by the equations 


(y.- 
O = arctan NY¥e¥q) 
oe (X,-X, ) 


(3.2) 
(Z,-Z,) 


pitch SE 
y (x,-%,)7*(y¥,-¥,)7 


The radar will send these angles to the respective yaw and 
pitch seeker elements. 

2. Command Guidance 

The CLOS radar will produce a cross range error signal 
and relay this signal to the missile autopilot. The cross 
range error is the distance between the missile and the radar 
to target LOS. Figure 4 shows the CLOS geometry. 

From Figure 4 and vector calculus the cross range error 


of the missile can be defined as follows 


s [IR x R,| 7 
\CRE| - aay To (3.3) 
R 


This calculation yields the following equation 





|CRE| - (VZV eZ _) + (Xp 2g XyZ—) + (K_V eX Vq) * (3.4) 


1 
IR, | 


The missile autopilot requires that the cross range error 
be broken into the yaw and pitch components. Analyzing Figure 


4 yields the following equations 


= re er - 
CRE. = /X,, y. cieeogl O a) 
a 2_ Oya - 
CRE os tch = CRE CRE .,, STOMO. .. Oo es 


The sign function ensures that the pitch plane cross range 


(3.5) 


error can be positive or negative. A positive cross range 
error indicates that the missile is leading the LOS. A 
negative cross range error indicates the missile is trailing 
the LOS. 


C. SEEKER DEVELOPMENT 


1. Proportional Navigation 

The seeker for proportional navigation measures the rate 
of change of the missile to target LOS angle. A simple 
gimballed seeker will use the angular rate of change of the 
seeker head as an estimate of the rate of change of the LOS 


angle. Figure 6 shows the seeker. 


Seeker 





Figure 6. Seeker Head Model 
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The equation of motion of the seeker head will yield the 
estimate of the angular rate of change of the LOS. The seeker 
head equations for the pitch and yaw planes will be identical. 
We will develop the equations for only the yaw plane. The 


equation of motion for the seeker head is given by 


4 = Desay B (3.6) 


where 
T = Torque applied to the seeker head 
I = Moment of inertia of the seeker head 
B = Seeker bore sight angle 

Solving (3.6) yields 


B - = - -k,(B-0) - k,B = -k,B-k,B+k,o (3.7) 


Taking the Laplace transform of (3.7) gives 


s*B(s) = -k,sB (s)-k,B(s)+k,0(s) (3.8) 


Then we solve for the seeker transfer function 


B(s) k, k, 


O(s) s *+k, s+k, 





(3.9) 





ane 
ho 


where Ty, is the seeker head time constant. 
A typical seeker head time constant is T,,= 1/8, using 


this value produces the following constants 


1] 


eg a eee Mr 
[| 6125 
(3.10) 
2 





The signal flow graph, using these constants, can be seen 


in Figure 7. 





Figure 7. Proportional Navigation Seeker SFG 


The following state space representation can then be 


implemented 
Leu a] = 
on - 64 -16 * on * 64 U sx 
X,| IB (3.11) 
Kou - x, ° 6 
u., = O 
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2. Command Guidance 
The CLOS missile control system does not contain a seeker 
head. All missile control functions are processed and 


developed by the fire control system located at the radar 


Site. 
D. GUIDANCE DEVELOPMENT 


1. Proportional Navigation 
| The missile guidance system implements the proportional 
navigation law explained in Chapter II. The major difference 
is that an estimate of the angular LOS rate is used vice a 
measurement of the actual LOS rate. Therefore, the rate of 


change of the missile's velocity vector is given by 


v,:- NB (3.12) 


This leads to the following state variable representation 


Va riten| [NO] [Posten (3.13) 


Y,, yaw ON B yaw 


2. Command Guidance 

The guidance for a CLOS missile is developed from the 
rate of change of the missile's cross range error. The 
missile acceleration is equal to the rate of change of the 
cross range error. This rate of change is then used as a 
commanded acceleration in the autopilot. 

The commanded acceleration is developed to provide good 
missile response. To ensure good response the missile 


acceleration must be of the form 


s?+(a+B)s+ap (3.14) 
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This will provide the damping necessary for the missile to 
perform correctly. 


Using equation (3.14) the following commanded 


acceleration is developed 
Ama = CRE + (CRE + PCRE (3.15) 
Taking the Laplace transform of (3.15) yields 


A ong (S$) 


= 6% 4 + 
CRE(s) s as +P (3.16) 


aM = 40 and op = 196 produces two real roots at s=-5.7171 and 
S=-34.2829. 
The signal flow graph for the guidance system is shown in 


Figure 8. 





Figure 8. Command To Line Of Sight Guidance SFG 


A state space representation of the guidance system is 
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pitch 





* cmdpsec| pes 40 0 0 | |CRE., cn — 
any} | 0 196 40]| CRE 
CRE 


yaw 


E. AUTOPILOT DEVELOPMENT 


1. Proportional Navigation 
A simple autopilot can be developed by applying a torque 
about the center of gravity of the missile. Analyzing the 


equation of motion 
T = IY, (3.18) 


and noting that this must also satisfy equation (3.14) to 


achieve stable performance, yields the following relationship 


T 


Las 


v= = -KV_ + KNB (3.19) 


Taking the Laplace transform of (3.19) yields 


Y,, (3) KN 


B (s) S$+K 








(3.20) 


and defining T,, as the autopilot time constant produces 


Ks (3.21) 


The signal flow graph for the autopilot, with k=1, is shown in 


Figure 9. 
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Figure 9. Proportional Navigation Autopilot SFG 


The state space representation can be written as follows 


se 














V misses -1 0 Mitch ; { - 
ee oa 7 o + AP 
Y ravay ae Y rapay Ot 
(3.22) 
N 0 p Most ch 
ll. = 
AP 10 N 
Ba 


The missile acceleration commands can be derived by 
looking at the missile's velocity vectors. Figure 10 shows 


the two-dimensional missile acceleration geometry. 


16 





Figure 10. Missile Acceleration Geometry 


It can be shown that the velocity in the pitch and yaw 


planes is given by 


voo=-V. cos (Y,, - oO ) 


yaw w May 


= V_ cos See, 


(3.23) 
Vos tch 


The acceleration components are then a function of the angular 


tate of change of the velocity vector 


a - V Y 
Maitch Doitch = ™pitch 


en 


‘yaw yaw ‘yaw 


(3.24) 


The angular acceleration commands are then distributed to the 
missile's cartesian coordinate accelerations using the 


following geometric relationships 
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Xen --a, 5 in (Oech) COS (O..,) 
Vin toon” “2 tpyep SPD (Opiten) Sin (G,,,,) 
ig ug COD NO yess) (3.25) 
a = “a, 8 in (0...) 
Vinay Fy OF ( Fyaw) 


The missile acceleration in each plane is then 


xX =X +X 
. Mttch Maw 
ae Vm ston + Ving (3.26) 
Z=Z 
a” Mottch 


and the total missile acceleration is 


a= Xo + v2 + 2? (3.27) 


2. Command Guidance 

The CLOS autopilot also takes the guidance commands and 
translates them into missile accelerations. Similar to the 
proportional navigation autopilot, this autopilot translates 
the angular accelerations into cartesian coordinate 
accelerations. 

The commanded angular accelerations of equation (3.15) 


are translated to cartesian accelerations using the following 
relationships 
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x = -a sin 
Mitch CMC, tech (0 ) cos (Oy) 


pitch 
Vee = -a ctgyee STM (Ops tn) sin(o,,,) 
a eas Oo 6 ea) (3.28) 
Ee = -a ond, S20 (O..,) 
ve =a ema, COS (Oo) 


The overall missile accelerations are also given by equations 


(3.26) and (3.27). 


F. MISSILE AND TARGET KINEMATICS 


The missile and target kinematics can be developed using 


the state space representation 


® e e T 
x,> (x, 4, Yn Yn Zu 2, 
(3.29) 
o « e T 
x, - |x, * YY. 4: z,| 
The system is then represented by 
x, 7 A, x, + 8, Uu, 
(3.30) 
x, = A, x, + B, u. 
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where 


yy 
ul 
yy 
u" 


(3.31) 


oO Ob Oo Oo O&O 
oOo Oo Oo CO fF 
oOo Oo oO Oo &:oOo 
oOo Oo Oo Oo O&O 
Oro oO oO oO 


0 
0 
1 
0 
0 
0 
u = LX, yz IF 
a Le, y, Z|" 


A signal flow graph for the missile and target kinematics can 


be seen in Figure 11. 


a cad, » Ps > @ Xn 


(a) Missile Kinematics SFG 


(b) Target Kinematics SFG 





Figure 11. Missile And Target Kinematics 


G. KALMAN FILTER DEVELOPMENT 


The introduction of noise into the simulation creates a 
more realistic scenario. The problem is to determine the 
target's flight path by filtering the noise. This simulation 


uses an extended Kalman filter to estimate the target's 
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flight. 

The noisy observed target flight is the input to the 
filter. The cartesian and spherical coordinates of the target 
are then used in the Kalman iteration to estimate the target's 
position. The filter is developed to use preprocessed linear 


pseudomeasurements. These measurements are given by 


r? 


(tan’atan?B + tan’a + tan*B+1) 


y(kT) = _r*tanfo (3.32) 
(tan’atan2B + tan’a + tan’B+1) 
z(kT) = _r*tan’B 
(1 + tan’B) 


a=LOS pitch angle 


x(kT) = 


where 


B=LOS yaw angle 


The measurement equation then becomes 


10000 0 | 
y(kT) = {0 0 1 0 O 0} x(kT) + V, (3.33) 
00001 0 
where V, = N(0O,R), and R = H(kT)R°H’(kT). H(kT) and R’ are 


given by 


Zz) 


dx(r,a,B) OSx(r,a,B) 65x(r,a,B) 











Or Oa OB 
Oy (r,a,B) Sy(r,a,B) Oy(r,a,B) 
eae Sr saSs=té<‘“‘SéS O#SC*~*;W 
62(r,a,B) O6z(r,a,B) S2(r,a,8) 
or Sot 5B ene 
o* 0 0 
R*=|0 0,’ 0 
0 O 0,” 
The discrete time system model then becomes 
X((k+1) 7) = Fx( kT) + Ww, 
W x N(0,Q) 
x 0 0 
Q=|0 x2 0 | 
008 (3.35) 
qr? gr 
3 2 
a = 2 
qT 
T 
> q 
The initial condition for the filter is 
x(0) = N(X,, P,) (3.36) 


Zz 


The Kalman algorithm is then given by the following set of 


equations 
Xp = PX 
Ea 2 eo 
K, = Pant LHP, A * + RI 
Kasra = *payx + K, Ly (kT) - HX, 1,1] 
Prayea = [I-K,H)P,,),CI-K#1] "+ KRK," 
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(3.37) 
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IV. SIMULATION RESULTS 
A. OVERVIEW 


The proportional navigation and CLOS simulations are 
tested using three target flight scenarios. In the first 
scenario the target has constant velocity and level flight in 
two dimensions. In the second, the target has a constant 
velocity and level flight in three dimensions. Finally, in 
the third, noise is added to the three-dimensional scenario. 

The Simulink models and associated MATLAB code for the 
proportional navigation and CLOS simulations are contained in 


the Appendix. 


B. SIMULATION ASSUMPTIONS 


The following assumptions are held throughout’ the 
Simulation: 
(1) Acceleration due to gravity does not effect the 
missile or the target. 
(2) The missile is lying in the xy plane at launch. 
(3) Missile acceleration is limited to 30g. 


(4) The proportional navigation constant is N=6. 
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C. SIMULATION SCENARTOS 


1. Constant Velocity In Two Dimensions 
The first scenario is a two-dimensional engagement. The 
target is flying at a constant altitude with no acceleration. 


The target parameters are as follows 


x, - 30000 ft 
x. = -3000 ft/s 
x. -0 ft/s? 
y,:0 ft 

y,+ 0 ft/s 

y, +0 ft/s? 
z.=-=1000 ft 

0 ft/s 

- 0 ft/s? 


N,N. 
S 


2. Constant Velocity In Three Dimensions 
The next scenario is a three-dimensional engagement. The 
target is flying at a constant altitude with no acceleration. 


The target parameters are as follows 


x. = 60000 ft 
x «= -2121 ft/s 
xX - 0 ft/s? 
y, - 10000 ft 
y, --2121 ft/s 
y,- 0 ft/s? 
z= 1000 ft 
Z.°0 ft/s 
zZ -0 ft/s? 
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3. Three-Dimensional Simulation With Radar Noise 

The final simulation uses the same target parameters as 
the three-dimensional constant velocity simulation. White 
noise is added to the target flight. This simulates received 
noise in the target's radar return. The noise has the 


following characteristics 


o.-15 £t 
= 
oe 


pitch 


D. RESULTS AND SIMULATION COMPARISON 


Figure 12 indicates the missile leads the target. This 
is attributed to the slow missile autopilot time constant 
(tp=1 sec) and the target's speed advantage of mach 3 to mach 
2 over the missile. This problem is exaggerated in figures 12 
and 13 since the z scale is twenty times the x scale. It was 
determined by considering the z acceleration profile in figure 
16, the z velocity profile in figure 19, and the z position 
profile in figure 12, that this effect was caused by the 
autopilot. | 

Figure 14 shows the rate of change of o is positive for 
approximately 1 second; thereafter it is negative but, for 2 
seconds the missile has a positive commanded acceleration. 
Figures 15 and 16 show the missile's acceleration variations. 


Figures 17, 18 and 19 show the missile's velocity variations. 
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Missile/Target Engagement in the xz Plane 
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Figure 12. Proportional Navigation Scenario 1. Missile and 
Target Trajectories in the xz Plane. 





Missile/Target Engagement 
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Figure 13. Proportional Navigation Scenario 1. Three- 
Dimensional Engagement Plot. 
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LOS Angle Sigma in the Pitch Plane 
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Figure 14. Proportional Navigation Scenario 1. LOS Angle 
Opitch. 


Commanded Acceleration in the x Direction 
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Figure 15. Proportional Navigation Scenario 1. Commanded 
Acceleration in the x Direction. 
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Figure 16. Proportional Navigation Scenario 1. Commanded 
Acceleration in the z Direction. 
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Figure 17. Proportional Navigation Scenario 1. Total Missile 
Velocity. 
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Figure 18. Proportional Navigation Scenario 1. Missile 
Velocity in the x Direction. 
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Figure 19. Proportional Navigation Scenario 1. Missile 
Velocity in the z Direction. 
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Plots for the other scenarios are given in the Appendix. 
The following table summarizes the missile's closest point of 
approach (CPA), and the time of the CPA for each simulation. 


= an ae 







CLOS 267.79 £t 22.34 Ss 


Table 1. Missile Miss Distance Summary 





Overall, the proportional navigation missile achieves a 
quicker target intercept time. The miss distances for each 
missile are very close, except when noise is added. The CLOS 
missile degrades Significantly in the presence of noise. 

The proportional navigation missile is a superior 
missile. The CLOS missile is unable to give satisfactory 
results when sensor noise is added to the simulation. For 
very short range intercept scenarios, where sensor noise is 
negligible, the missile will perform well. The proportional 
navigation missile will perform well for any engagement 
scenario. This fact makes proportional navigation preferable 


for missile guidance. 
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V. CONCLUSIONS AND RECOMMENDATIONS 
A. CONCLUSIONS 


The simulation provides insight in chosing the proper 
type of missile guidance. The two types of guidance explored 
both give acceptable miss distances without sensor noise. 
However, when sensor noise iS present the proportional 
navigation missile outperformed the CLOS missile. 

' The presence of an on board seeker gives the proportional 
navigation missile an advantage when dealing with sensor 
noise. Since the sensor is on the missile as it closes the 
target, the sensor noise will have less of an effect on the 
detection of the target. The CLOS missile is guided from a 
stationary radar at the launch site. The error incurred from 
sensor noise does not decrease as the missile approaches the 
target. To overcome this problem the CLOS missile will 
require a very sophisticated tracking radar that has very 
little sensor noise. 

The addition of noise to the engagement provides a more 
realistic scenario for the missile control problem. 
Developing a noise filter and adjusting the missile 
characteristics to adapt to the noise created a unique and 
educational challenge. The increased realism reinforced the 
fact that actual missile control developement is a compromise 


of design requirements. 


B. RECOMMENDATIONS 


The simulation can be taken to several different levels. 
The target flight can be modified for different engagement 
scenarios. A manuevering target would provide another level 
of realism to the engagement. 


An adjoint model could be built for each simulation. 
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This would aid in the miss distance analysis for the two 
missiles. 

Finally, different noise filters can be developed and 
tested. The miss distance will be decreased if better noise 


filtering is achieved during the simulation. 
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APPENDIX 


A. COMMAND GUIDED MISSILE PLOTS FOR SCENARIO 1 
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Figure 20. Command Guidance Scenario 1. Missile and Target 
Trajectories in the xz Plane. 
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Figure 21. Command Guidance Scenario 1. Three- Dimensional 
Plot. 
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Figure 22. Command Guidance Scenario 1. Cross Range Error. 


36 


Commanded Acceleration in the x Direction 
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Figure 23. Command Guidance Scenario 1. Commanded 
Acceleration in the x Direction. 
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Figure 24. Command Guidance Scenario 1. Commanded 
Acceleration in the z Direction. 
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Missile Velocity 
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Figure 25. Command Guidance Scenario 1. Total Missile 
Velocity. 
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Figure 26. Command Guidance Scenario 1. Missile Velocity in 
the x Direction. 
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Figure 27. Command Guidance Scenario 1. Missile Velocity in 
the z Direction. 
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B. PROPORTIONAL NAVIGATION MISSILE PLOTS FOR SCENARIO 2 


Proportional Navigation Missile/Target Engagement Scenerio 2. 
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Figure 28. Proportional Navigation Scenario 2. Missile and 
Target Trajectories in Three Dimensions. 
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Figure 29. Proportional Navigation Scenario 2. Missile 
Target Trajectories in the xy Plane. 
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Figure 30. Proportional Navigation Scenario 2. Missile and 
Target Trajectories in the xz Plane. 
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Missile/Target Engangement in the yz Plane 
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Figure 31. Proportional Navigation Scenario 2. Missile 
Target Trajectories in the yz Plane. 
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Figure 32. Proportional Navigation Scenario 2. LOS Angle 
Opitch. 
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LOS Angle Sigma in the Yaw Plane 
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Figure 33. Proportional Navigation Scenario 2. LOS Angle 
Oyaw. 
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Figure 34. Proportional Navigation Scenario 2. Commanded 
Acceleration in the x Direction. 
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Commanded Acceleration y Direction 
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Figure 35. Proportional Navigation Scenario 2. Commanded 
Acceleration in the y Direction. 
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Figure 36. Proportional Navigation Scenario 2. Commanded 
Acceleration in the z Direction. 
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Figure 37. Proportional Navigation Scenario 2. Total Missile 
Velocity. 
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Figure 38. Proportional Navigation Scenario 2. Missile 
Velocity in the x Direction. 
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Figure 39. Proportional Navigation Scenario 2. Missile 
Velocity in the y Direction. 
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Figure 40. Proportional Navigation Scenario 2. Missile 
Velocity in the z Direction. 
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C. COMMAND GUIDED MISSILE PLOTS FOR SCENARIO 2 


Command To Line Of Sight Missile/Target Engagement Scenerio 2 
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Figure 41. Command Guidance Scenario 2. Missile Target 
Engagement. 
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Figure 42. Command Guidance Scenario 2. Missile Target 
Trajectories in the xy Plane. 
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Figure 43. Command Guidance Scenario 2. Missile Target 
Trajectories in the xz Plane. 
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Figure 44. Command Guidance Scenario 2. Missile and Target 
Trajectories in the yz Plane. 
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Figure 45. Command Guidance Scenario 2. Missile Cross Range 
Error. 
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Cross Range Error in the Pitch Plane 
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Figure 46. Command Guidance Scenario 2. Cross Range Error in 
the Pitch Plane. 
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Figure 47. Command Guidance Scenario 2. Cross Range Error in 
the Yaw Plane. 
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Commanded Acceleration in the x Direction 
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Figure 48. Command Guidance Scenario 2. Commanded 
Acceleration in the x Direction. 
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Figure 49. Command Guidance Scenario 2. Commanded 
Acceleration in the y Direction. 
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Figure 50. Command Guidance Scenario 2. Commanded 
Acceleration in the z Direction. 
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Figure 51. Command Guidance Scenario 2. Total Missile 
Velocity. 
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Figure 52. Command Guidance Scenario 2. Missile Velocity in 
the x Direction. 
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Figure 53. Command Guidance Scenario 2. Missile Velocity in 
the y Direction. 
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Figure 54. Command To Line Sight Scenario 2. Missile 
Velocity in the z Direction. 
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D. PROPORTIONAL NAVIGATION MISSILE PLOTS FOR SCENARIO 3 
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Figure 55. Proportional Navigation Scenario 3. Missile and 
Actual Target Trajectory. 


55 


Missile Target Engagement 


Distance (ft x 1e4) : Distance (ft x 1e4) 





Figure 56. Proportional Navigation Scenario 3. Missile and 
Filtered Target Trajectory. 







Missile and Actual Target Engagement in the xz Plane 


Missile and Fittered Target Engagement in the xz Plane y 70° 





= 1500 
° 
5 1000 
= 500 
0 
0 1 2 3 4 5 6 7 
Distance (ft x 1e4) 4 


Figure 57. Proportional Navigation Scenario 3. Missile and 
Target Trajectories in the xz Plane. 
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Figure 58. Proportional Navigation Scenario 3. Missile and 
Target Trajectories in the xy Plane. 
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Figure 59. Proportional Navigation Scenario 3. Missile and 
Target Trajectories in the yz Plane. 
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Figure 60. Proportional Navigation Scenario 3. Total Missile 
Velocity. 
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Figure 61. Proportional Navigation Scenario 3. Missile 
Accelerations. 
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E. COMMAND GUIDED MISSILE PLOTS FOR SCENARIO 3 
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Figure 62. Command Guidance Scenario 3. Missile and Target 
Trajectory. 
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Figure 63. Command Guidance Scenario 3. Missile and Target 
Trajectories in the xy Plane. 
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Figure 64. Command Guidance Scenario 3. Missile and Target 
Trajectories in the xz Plane. 
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Figure 65. Command Guidance Scenario 3. Missile and Target 
Trajectories in the yz Plane. 
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Figure 66. Command Guidance Scenario 3. Cross Range Error. 
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F. PROPORTIONAL NAVIGATION SIMULINK MODEL 
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Figure 67. Proportional Navigation Missile Model. 
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Figure 68. Target 
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Figure 69. Target Flight without noise. 





Figure 70. Proportional Navigation Pitch and Yaw Seeker. 
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Figure 71. Proportional Navigation Pitch and Yaw Autopilot. 
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Figure 72. Proportional Navigation Missile Flight in the x 
Direction. 
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Figure 73. Proportional Navigation Missile Flight in the y 
Direction. 
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Figure 74. Proportional Navigation Missile Flight in the z 
Direction. 
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Figure 75. Proportional Navigation CPA and Stop Simulation 
Calculation. 
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Figure 76. Proportional Navigation CPA Calculation. 
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G. COMMAND GUIDANCE SIMULINK MODEL 
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Figure 77. Command Guidance Missile Model. 
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Figure 78. Command Guidance Target Flight with Noise. 
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Figure 79. Command Guidance Target Flight without Noise. 
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Figure 80. Command Guidance Missile Flight. 
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Figure 81. Command Guidance Target Range. 
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Figure 82. Command Guidance Sigma Yaw Calculation. 
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Figure 83. Command Guidance Sigma Pitch Calculation. 
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Figure 84. Command Guidance Sigma Calculation. 
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Figure 85. Command Guidance Cross Range Error. 
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Figure 86. Command Guidance Cross Range Error Yaw. 
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Figure 87. Command Guidance Cross Range Error Pitch. 
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Figure 88. Command Guidance CPA Calculation. 
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Figure 89. Cartesian to Spherical Block for both 
Simulations. 
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H. MISCELLANEOUS MATLAB CODE 


% This program generates the noise used in the target flight. 
randn('seed', 26579) ; 
ti=[0:.001:30]; 
for i= 1:30001 
Range noise 
U(i) = randn*15; 
Pitch angle noise 
V(i) = randn*pi/1iso; 
Yaw angle Noise 
W(i) = randn*pi/180; 
end 
This program sets the initial conditions for the Kalman 
Filter. It is run at the beginning of each simulation. 
clear P 
clear xhat 
global P. 
global xhat 
initial covariance matrix 
P=le6*eye (6) ; 
initial estimated target position 
xhat=[10000 -500 1000 -500 0 500]'; 
This function runs a Kalman filter algorithm 
for the given A, B, C matices for constant velocity flight 


function {xhat,P]=klmn(u,P,xhat) ; 


$initialization 
A=[0 1000 QO; 
0000 0 0; 
00010 0; 
000 0 0 Q; 
00000 1; 


76 


00000 0}; 
B= [0;0;0;0;0;0); 
C=([1 0000 QO; 
001000; 
00001 0); 
Time step and q parameter for the Kalman Filter 
q=1; 
dt=.001; 
Continuous to discrete conversion 
[phi,del] =c2d(A,B,dt) ; 
Specify position and angle vectors 
pos= ({u(1) ;u(2) ;u(3)]; 
ang= [u(4) ;u(5);u(6)]; 
Calculate Sigma Matrix 
sigma=[((q*2)* (dt) *3)/3 ((q*2)* (dt) *2)/2; 
((q*2)*(dt)*2)/2 (q*2)*(dt)); 
Calculate OQ Matrix 
O=[sigma zeros(2,2) zeros(2,2); 
zeros(2,2) sigma zeros(2,2); 
zeros(2,2) zeros(2,2) sigma]; 
Calculate Rstar Matrix 
Rstar=[225 0 0;0 (1*pi/180)*2 0;0 0 (1*pi/180) *2]; 
Kalman iteration 
xhatkp1 = phi*xhat; 
Pkp1l = phi*P*phi'’ + Q; 
H = calch(ang) ; 
R = H*Rstar*H’ ; 
K = Pkpi1*C'*inv(C*Pkp1*C'+R) ; 
Pk1iki (eye(6) -K*C) *Pkp1* (eye(6) -K*C)' + K*R*K'; 
xkik1 = xhatkpl + K* (pos(:,1)-(C*xhatkpl)); 
global xhat; 
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xhat = xk1ki1; 

global P; 

P = Pkiki1; | 
This function calculates the H matrix for computation 
tin a Kalman filter 
function [H] =calch(x) 

a=(tan(x(2)))°*2; 
b= (tan(x(3)))*2; 
c= (sec(x(2))) *2; 
d= (sec (x(3)))*2 


e=tan(x(2)); 


f 


f=tan(x(3)); 


H = [1/((a*btat+b+1)*.5) -x(1)* (b*etct+c*e) /( (a*b+atb+1) *1.5) 
~X (1) * (a*d*f+d*f£) /( (a*bta+bt+1) *1.5); 
e / ( ( a * bo + AQ + DH + FZ) : : 5 ) 


~x (1) * (a*c* (b+1))/( (a*bt+tat+b+1) *1.5)+x(1)*c/ ( (at*bt+tat+b+1)*.5) 
~X (1) *e* £*d* (at+1) /( (a*bt+tat+bt+1) *1.5); 
£/((1+b)*.5) 0 -x(1)*b*d/((1+b) *1.5)+x(1)*d/((1+b)*.5)]; 
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